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SUMMARY 


A simple Kalman filter for potential use in STOL 
navigation systems is described. The mathematical formula- 
tion of all the elements of the filter, its initialization 
and over all operation are presented. Simulation results 
show that on a typical approach flight to landing, the 
Kalman filter has much smaller errors during navigation on 
TACAN data and during transition from TACAN to MODILS data 
than a complementary filter. 

Summary-type flow charts of the Kalman filter 
logic designed for the Sperry 1819A computer are presented. 
Also, the memory and real-time requirements of the Kalman 
filter and complementary filter are described. The Kalman 
filter is shown to gain its superior performance at the 
expense of real-time and memory required in the onboard 
computer. These requirements are not, however, excessive 
for modern airborne computers. 


iii 
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I. 


INTRODUCTION 


This report describes the design and simulation re- 
sults of a Kalman filter for potential application in the 
STOLAND. The STOLAND is a digital avionics system designed 
for testing terminal area guidance, navigation and control 
concepts for short-haul aircraft, and investigating operational 
procedures (see Ref, [1]). The current navigation system in 
STOLAND (see Ref. [2]) uses a complementary .filter to blend 
ground navigation information with onboard inertial and 
airdata information. The Kalman filter described in this 
report operates in parallel with the complementary filter 
using the same onboard and navigation aid information, so that 
direct comparison of the performance of the two filters during 
simulation and flight tests is possible. The effort described 
herein carried the design through simulation validation; hence, 
comparative results of the two filters obtained from simulation 
are presented. As will be seen, the Kalman filter exhibits 
considerably smaller errors in the presence of biases in the 
ground navigation aid measurement or in the transition from 
one ground navigation aid to another. This improved perform- 
ance is obtained at the expense of greater computer memory and 
real-time for the Kalman filter. Comparisons of the memory 
and real-time requirements of the two filter mechanizations is 
also presented. 

The overall mechanization and design constraints of 
the Kalman filter are described in section III. Section IV 
gives the mathematical formulation of the design. Some pre- 
liminary results obtained from simulation are given in section 
V. A summary type description of the Kalman filter part of 
the 1819A software is given in the Appendix. 





II. 


NOTATION AND SYMBOLS 


The notation of or over a symbol will have 

its customary meaning of differentiation with respect to time. 
The (hat) mark over a symbol means the "estimated" or 

"computed" value of the symbolized quantity, while the 
(tilde) indicates an error or small variation in the symbolized 
quantity. For instance, if x is the true value of the posi- 
tion component, then it may be written as the sum of the 
estimated component and the error. 

X ^ Si + St 

T 

The notation ( ) means the transpose of the quantity. 


xb 


yb 


^ i 

c 

dx 

F 

n 


H 


H. 


m 


Roman Symbols 

The transition matrix minus the identity matrix. 

The acceleration bias along the runway. 

The acceleration bias normal to the runway. 

Bias in the TACAN range measurement. 

Bias in the TACAN bearing measurement. 

Coefficient used in data rejection. 

The error state with components defined in Table 3.1. 

Jacobian matrix of the state rates with respect to 
random forcing functions. 

Jacobian matrix of the state rates with respect to 
the estimated state. 

Gradient of the measurement with respect to the 
estimated state. 

H referred to the Kalman filter reference time 
(H(t) $ (t; t^)) 
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H. 

< 

H 

H 

i 

H 

H 

H 

K 

n 

n 

P 

q 

q 


ax 


ay 


ma 


mr 


tb 


tr 


m 


ax 


'ay 


*ma 


^mr 


'tb 


^tr 


ax 


ay 


'ma 


■mr 


'tb 


tr 


H for along runway airspeed measurement. 

H for normal to runway airspeed measurement. 

H for MODILS azimuth measurement. 

H for MODILS range measurement. 

H for TACAN bearing measurement. 

H for TACAN range measurement, 

Kalman filter gain. 

Noise vector. 

The number of residuals in a sum. 

Covariance matrix. 

Random error in a measurement. 

q for along runway airspeed measurement. 

q for normal to runway airspeed measurement. 

q for MODILS azimuth measurement. 

q for MODILS range measurement, 

q for TACAN bearing measurement. 

q for TACAN range measurement. 

Variance of the random error in a measurement. 

Q for along runway airspeed measurement, 

Q for normal to runway airspeed measurement. 

Q for MODILS azimuth measurement. 

Q for MODILS range measurement. 

Q for TACAN bearing measurement 

Q for TACAN range measurement. 

Computed range from MODILS azimuth scanner. 

Level component of distance from MODILS azimuth 
scanner , 
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t 


u(t^) 

u 



X 


y 


z 

X 


* m 



m 


Y 

Y 


ax 


ay 


zna 


mr 


Tirue 

Reference time for the Kalman filter 
Discrete noise vector. 

Square root covariance of noise vector, . 

Along runway component of velocity. 

Normal to runway component of velocity. 

Along runway component of wind. 

Normal to runway component of wind. 

T 

Square root covariance matrix, WW = P. 

Along runway component of position. 

Normal to runway component of position. 

Down component of position. 

Position of MODILS DME transponder and azimuth 
scanner with respect to the runway reference. 


Position of TACAN station with respect to the 
runway reference. 

Raw acceleration along runway. 

Raw acceleration normal to runway. 

Measurement residual. 

Mathematical model of a measurement. 

Y for along runway airspeed measurement. 

Y for normal to runway airspeed measurement. 

Y for MODILS azimuth measurement. 

Y for MODILS range measurement. 
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Y for TACAN bearing measurement. 

Y Y for TACAN range measurement . 

tr 



Ay 

-'m 

n 



Greek Symbols 

Time interval 

Time interval between filter reference points. 

Best estimate of residual, including past measure- 
ments . 

The residual sum for an arbitrary measurement. 
Vector defined in Potter's algorithm [4.14]. 

Vector defined in Potter's algorithm [4.14], 

Scalar defined in Potter's algorithm [4.14]. 
Standard deviation (std) of a random variable. 

Std of noise in acceleration bias model. 

Std of a residual sum. 

Std of noise in TACAN range bias model. 

Std of acceleration noise for model compensation. 
Std of noise in wind model. 

Std of measurement residual. 

Std of noise in TACAN bearing bias model. 

Time constant in acceleration bias model. 

Time constant in TACAN range bias model. 

Time constant in wind model 

Time constant in TACAN bearing bias model. 

The state transition matrix - 

Matrix of state sensitivity to forcing functions. 
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Magnetic heading of the aircraft. 

Magnetic azimuth of the runway. 

Gradient of function with respect to state. 



III. 


OVERALL MECHANIZATION AND DESIGN CONSTRAINTS 


3 . 1 Overview 

Prior to initiation of the work described in this 
report, NASA had conducted an in-house study effort to assess 
the potential performance improvements in using a Kalman fil- 
ter in the STOLAND system. This in-house study had configured 
the overall mechanization with respect to factors such as: 

(1) the state variables to be included in the 
filter design; 

(2) the measurements to be processed by the 
filter, and 

(3) the operating regions in the flight-envelope 
where the Kalman filter was to operate. 

In addition, the filter was to be designed to operate within 
the available memory and real-time in the Sperry 1819A com- 
puter without effecting the operation of any of the existing 
software. This latter constraint meant that the onboard 
filter had to be designed to operate with less than 4000 
words of memory and less than about 25% real-time of the 
1819A computer. 

Another constraint was that the Kalman filter 
should use the same measurement da;ta used in the complemen- 
tary filter. This constraint allows a reasonable comparison 
of the performance of the Kalman filter with the complemen- 
tary filter. Improved performance with the more sophisti- 
cated filter is to be expected at the expense of more memory 
and real-time utilization. By using the same measurement 
data in both filters, a reasonable trade-off between perfor- 
mance and complexity was anticipated. 

This section presents the overall mechanization of 
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the NASA baseline design and the error state vector developed 
by this design. 

3.2 Overall Mechanization 


Figure 3.1 presents the NASA baseline design for the 
onboard Kalman filter. The external sensor measurements used 
by the filter include; 

(1) attitude and heading, 

(2) body-mounted accelerometers, 

(3) air data, 

(4) TACAN range and bearing, and 

(5) MODILS range and azimuth. 

Existing software in the 1819A computer calculates the 
acceleration in a runway reference which is fed to the 
navigation equations, and the true airspeed in runway ref- 
erence which is input to the Kalman filter algorithm. The 
TACAN range, bearing and their validity flags and the MODILS 
range, azimuth and their validity flags are also formatted 
and scaled by the existing software before being sent to the 
Kalman filter. 

The navigation equations appropriately integrate 
the runway referenced acceleration at lOHz to form the 
position and velocity estimates. These quantities as well as 
the other state variables included in the estimated state are 
also input to the Kalman filter algorithm. 

The Kalman filter algorithm computes the error in 
the estimated state from the input information which in turn 
is fed back and added to the state estimate carried by the 
navigation equations. The Kalman filter algorithm requires 
lengthy calculations, so in order to keep its operations 
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Figure 3.1. NASA Baseline Design of Overall Mechanization 









within the available machine time, the estimated error state 
is calculated at a iHz frequency. 

In order to use all the navigation and data which 
is available at lOHz, the Kalman filter contains preprocessing 
routines for "averaging" the navaid data. These operations 
will be described in section IV. 


3.3 Error-State Vector 


The error-state vector used in the Kalman filter of 
Figure 3.1 is given in Table 3.1. 

Table 3.1, Error-State Vector 


Element 

1 

2 

3 

A 

5 

6 

7 

8 
9 

10 


Symbol 

X 

y 

v._ 


v_ 


xb 


Vb 




w 


w 


Definition 

position error along the runway 
position error normal to runway 
velocity error along the runway 

velocity error normal to runway 

bias error in acceleration along runway 

bias error in acceleration normal to runway 

bias error in TACAN range measurement 

bias error in TACAN bearing measurement 

error in estimate of wind along the runway 

error in estimate of wind normal to runway 


As may be noted, the state variables estimated by 
the filter only involve the level (x, y) components of navi- 
gation quantities. A navigation system requires a. vertical 
channel also; however, the NASA baseline design had relegated 
studies associated with a 3-axis system to a later effort con- 
tingent on the results of the simpler level-axis design. 
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The first four elements of the error-state are level 
components of position and velocity. The fifth and sixth com- 
ponents are acceleration biases which are treated as exponen- 
tially correlated noise variables. These two biases account 
in part for the errors in the simple strapped-down inertial 
system. These acceleration biases are also calculated by the 
complementary filter (see Ref. 2) . 

The seventh and eighth error-state variables are 
biases in the range and bearing data from the TACAN station. 
These quantities are also treated as exponentially correlated 
noise variables. 

The ninth and tenth error- state variables are errors 
in the two components of winds. These are treated as expo- 
nentially correlated noise variables to account for wind changes 
during the approach flight profile. The airdata was used in 
the Kalman filter to both provide the estimates of winds and 
for the potential help in smoothing the ground velocity esti- 
mates obtained from the filter. 
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FILTER IMPLEMENTATION 


IV. 

The navigation equations (see Figure 3.1) integrate 
the accelerometer data at a high rate (10 Hz), to keep the 
estimate of state current. Measurements of state from the 
TACAN and MODILS receivers, and the computed true air speed 
feed the Kalman filter of Figure 3.1. The filter uses the 
measurements and the current estimate of state to calculate 
an incremental change in the current estimate which is in 
turn added to the current estimate. 

This section starts by summarizing the basic filter 
equations. Next, the navigation equations used for keeping 
the estimate of state current and the error equations for use 
in the time update of the filter are summarized. Next, the 
formulations are developed for processing measurements by the 
filter. The section concludes with a brief discussion of how 
the system is initialized. 

4.1 Summary of the Kalman Filter Algorithm 


The Kalman filter algorithm involves a very large 
number of machine operations. The basic algorithm separates 
into the following: 

1- Calculations associated with a change in the 
time reference of the filter, and 

2. Calculations of the incremental state estimate 
from the measurement information. 

In order to keep the number of operations within the capa- 
bilities of current airborne computers the time reference is 
changed at a moderately low frequency (e.g., iHz) and 



average type measurements are processed at a moderately low 
frequency (e.g. , 1 Hz) . 

It is a well know fact that a practical filter 
design must minimize effects caused by: (1) numerical 

calculation errors such as truncation, and (2) modeling 
errors resulting from various approximations. 

Past experience has shown that the square root 
implementation of the optimal filter algorithm (references 
[3] and [4]) can reduce the effects of numerical errors to 
insignificant levels. The square root implementation is 
therefore incorporated in the design. Modeling errors are 
compensated by the appropriate use of random forcing functions. 
This technique causes the more recent measurements to be 
weighted more than past measurements? therefore, the estimate 
tends to follow the more recent measurements. 


The onboard filter operates in a manner illustrated 
in the sketch below: 



-1 1 1 # 

t t t 

8 9 k+1 


At the start of the sequence we assume that the 
filter has its covariance matrix referenced to time tj^. At 

the times tj^, t^ measurements are accepted and 

residual sums and partials are computed and saved in the 
preprocessing routines. After accepting the measurement at 
time t^ the residual sums and partials are transferred to 
arrays for processing by the filter and the locations used 

.fox the preprocessing are cleared for use in preprocessing 
the measurements at the subsequent measurements. 

The residual sums are processed by the filter and the incre- 
mental state change computed in lower priority logic. When 
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these lower-priority calculations have been completed, the 
logic sets markers which cause the higher priority logic to 
pick up the state change and add it to the system. Meanwhile, 
the lower priority logic updates the covariance matrix to the 
time tj^^^ ^nd readies the filter for processing the residual 
sums in the next interval. The onboard program operations 
for executing this logic in the Sperry 1819A computer are 
described in the Appendix. 

Time Update Operations 

The error state given in Table 3.1 is assumed to 
obey the vector differential equation. 


dx = F dx + F n, 
X n 


(4.1) 


where 


dx = 

'•x = 
= 

n = 


the n(10) component error state vector 
an nxn matrix 
an nxm matrix 

an m vector of random forcing functions for 
compensation of error growth caused by unmodeled 
error sources. 


An approximate solution of (4.1) is. 


(4.2) 


where 


u 




the transition matrix, 

the forcing function sensitivity matrix, 
a constant (in the interval t^^ to vector 

for approximating the effects of the noise vector, 
n, of (4.1) . 
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The covariance matrix for the error state at time 
is given by. 


t 


k 


P(tj^) = W(tj^)W(t^)'^ = E(dx(tj^)dx(tj^)'^) , (4.3) 


where 

W(tj^) = the square root covariance. (W^^is calculated 
in the square root implementation of the 
filter) , 

E() = the expected value operator. 


We assume that u(tj^) is a random independent vector such that 


E(u(tj^^i)u(t^^,)^) = 0 


- U(t3^^.)U(t^^.) 


i ^ I 
i = f 


(4.4) 


The appropriate use of the expected value operator with 
Equation (4.2) gives the time update of the covariance matrix. 




$W(t, ) ^ U 
k u 


u 


(4.5) 


We see from Equation (4.5) that we can form W(t. .t)"^ in two 

K+l 

steps as follows: 




W(tj^) 




(4.6) 


The matrix, Equation (4.6) has dimension 

(n+m) X n. The Householder algorithm described in References 
CBT' and [4] can be used to reduce this matrix to an upper 
triangular form; that is, all the terms below the diagonal 
are zero in the reduced matrix. The matrix reduction 
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algorithm leaves the product WW 


T 


invariant* 


Section 4.2 of this report gives details on the matrices 
and U involved in the time update operations. 

Measurement Processing Operations 

The measurement residual, Y defined by. 


y^(t) = measured value - Y(x,t), 


(4.7) 


where 

Y(x,t) = the computed value of the measurement based on 
the current estimate of state indicated by the 
output of the navigation equations. 


It is assumed that the residual is related to the error 
state by, 

Yjj^(t) = Hdx(t) + q, (4.8) 


where 


q = the random error in the measurement. 


Since we may have an estimate of dx given by dx from 
other measurements, we write (4.8) as, 

-A 

“ Hdx(t) = Hdx(t) + q (4.9) 

= our best estimate of the residual 
including any past measurements whose 
effect is not yet included in the 
estimate of state carried by the 
navigation equations. 


As was mentioned in the beginning of this section, the 
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filter operates with the reference time tj^ for measurements 
in the interval t^^ to This means that we estimate 

d5^(tj^) rather than d3^(t). Hence we make the assumption for 
tj^<t<tj^^j^ that 


dx(t) = $ (t;tj^)dx(tj^) . (4.10) 

Equation (4.9) can then be written as, 

Ay = y^^t) ~H$(t;tj^)dS(tj^) . (4.11) 

One may note that (4.10) and (4.2) are in disagreement 
since the influence of the random forcing function, u(t, ) , 
is ignored in (4.10). The effect of this simplification is 
that measurements are not quite optimally weighted. Expe- 
rience has shown that this simplification is justified if the 
batch interval Aj^= is short compared to natural 

periods of error growth in the navigation equations. 


We let, 

H^= 

Q = E(q^) . 

Then the estimate of the error state following inclusion of 
the measurement is, 

(4.13) 

In (4.13) the subscript notation ( ), and ( ) means before 

D a 

and after inclusion of the measurement, respectively. 
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The square root covariance matrix, W(t )■*■, after in- 

JC 

elusion of the measurement is given by. 


W(t^)/ = W(tj^) J - enV, 


(4.14) 


where 


rp rn 

c = W(t, ), H 
kb m 


n = w(t^)j^c, 


K = (c'''c+q)(i+/q/(c'^c+Q) ) 


Equation (4.14) is referred to as Potter's algorithm (see 
Reference [3] ) . 


In order to minimize the number of measurement 

operations we will use accumulated residuals over a one-~second 

period. This means that the residual, (4.7) is the 

accumulated residual for all the measurements of the same type 

in a one-second interval. The partial (H of (4.12)) is cai- 
rn 

culated and accumulated simultaneously with the residual 
accumulation. The Q of Equation (4.12) is the assumed vari- 
ance of the random error in the accumulated residual 
(residual sum) . More details on the residual sum processing 
are given in section 4.4. 


4.2 


estimate 


Navigation and Error Equations 

The navigation equations used to keep the state 
current involve a double integration of 

Kb) 



where , 



raw acceleration in runway reference com- 
puted by existing software (see Ref. [23), 
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= estimates of acceleration bias. 

The first integration of (4.15) gives the estimated velocity 
with respect to the runway and the second integration gives 
the estimated position with respect to the runway. Equation 
(4.15) is an approximation which is valid for a "flat" non- 
rotating earth. The errors resulting from this approximation 
are negligible in comparison to the errors caused by inertial 
hardware components (that is, the errors in the attitude and 
heading references and the errors in the body-mounted accel- 
erometers) . In the onboard program the raw acceleration data 
is accepted at 20Hz and averaged. The average acceleration 
is integrated at lOHz, 



Error Eguations 


The vector form of the error equations was given in 
(4.2) where the error state vector, dx, was defined in Table 
3.1. In the subsequent summary we assume that elements of 
the noise vector u(tj^) are all independent variables with 
unit variance. The gain associated with the noise is included 
in the constants of the matrix of (4.2). We also define 
the transition matrix, as 

4> = I + A (4.16) 


The nonzero elements of A are given in (4.17). 


A (1,3) = A (2,4) = A (3,5) - A (4,6) = A 
A (1,5) = A (2,6) = A^/2 

A (5,5) = A (6,6) = -A/t^ 

A (7,7) = -A/Tj. 

A (8,8) = -A/t 

A (9,9) = A (10,10) = -A/t, (4.17) 

Vv 

in (4.17) 
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A ~ period over which the transition matrix is 
used. 

T = time constant for acceleration bias colored 
a 

noise (100 sec . ) 

= time constant for TACAN range bias colored 
noise (1000 sec.) 

= time constant for TACAN bearing bias colored 
noise (1000 sec.) 

T = time constant for wind error bias colored 
w 

noise (100 sec.) 

Nominal values for the time constants in the pro- 
gram are shown in parentheses. 


The nonzero elements of ^ are given in (4.18) 
$u(3,3) = $^(4,4) = “ 

\is.5) = $^( 6 , 6 ) = 

$„( 7 , 7 ) = 

^( 8 , 8 ) = 


\(9,9) = $^(10,10) = V2A^/t^ 


(4.18) 


In (4.18) 

“ period of the time update (1 second) 

0^ = standard deviation (std) of velocity noise 
(.0762m/s) 

a = std of acceleration bias colored noise 
a 


(.1524m/s) 

= std of TACAN range bias colored noise (304.8m) 

= std of TACAN bearing bias colored noise (2 deg) 

o = std of wind bias colored noise (6.1m/s) 
w - 
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Nominal values for the standard deviations are 
given in parentheses. 

4 . 3 Measurement Models 

The measurement models are required for; 

1. defining the computed measurement as a 
function of the estimated state (i.e., 

Y(5^,t) of (4.7)), 

2. defining the partial which relates the 
residual to the error state (i.e., H of 
(4.8)) and 

3. defining the variance of the random error 
in measurement (i.e., Q of (4.12)) • 

The models used in the onboard program are devel- 
oped in this section for TACAN, MODILS and the airspeed 
measurements . 


TACAN Model 

TACAN measurements consist of (a) the range from 
the aircraft to the station and (b) the bearing (with respect 
to magnetic north) of the station with respect to the air- 
craft. The range measurement is assumed to obey 


/ ^ 

\r "" ^ (y“yrj.) 

where 


2 

+ (z-z^) + b + q. 

T r tr 


(4.19) 


x,y, z 


/ yrjjTi / 



= the coordinates of the aircraft with 
respect to the runway reference 
= the coordinates of the TACAN station 
with respect to the runway reference 
= the bias error in the range measure- 
ment 

- the random error in the range 
measurement 
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The estimated measurement is computed from 


tr - /(x-x^)^ + (Y-Yt) ^ + (z-Zm)^ + b, 


(4.20) 


where 


/s 


XfY/b^ are state variables of the filter and z 
r 


is obtained from the complementary filter (see Reference 2) . 

The nonzero elements of the row vector/ H of (4.8) 
are calculated from 


H 


tx<l) = (x-x^/(Y^^-b^) 




(4.23) 


The variance of the random error in the TACAN 
range measurement, is assumed to be a constant given by 


tr (46m) 


(4.24) 


The bearing measurement is assumed to obey 


_1 (YtTY) 

• r. = tan h — - — + b, + q.. 
tb ‘'(x^-'x) ^r ^tb 


(4.25) 


where 


'^r 


the azimuth of the runway with respect to 
magnetic north 

the bias error in the bearing measurement 


= the random error in the bearing measurement 
tb 


- 25 - 



tb 


The estimated measurement is computed from 
_i (y^' y) 

= tan t + + bj, 


(4.26) 


>N A% 


where x, y and are state variables of the filter. 

The nonzero elements of the row vector, H of (4.8) 
for the bearing measurement are calculated from 

2 2 

H^j^(i) = (y.p-y)/C (x-Xrp) + iY'-y^) 3 

2 2 

Htb(2) = (x-xpj.) /[ (X-X.J.) + (y-y.p) 3 


Htb(8) = 1 


(4.27) 


The variance of the random error in the TACAN 
bearing measurement, assximed to be a constant given 

by 

Q = (.5 deg) (4.28) 

tb 


MODILS Model 


The MODILS measurements used in the onboard Kalman 
filter are range and azimuth from a colocated DME trans- 
ponder and azimuth scanner. The range measurement is assumed 
to obey 


where 


x,y,z = coordinates of the aircraft with respect 
to the runway reference 
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X ,y ,z = coordinates of the transponder and 
m ni ^ 

scanner with respect to the runway 
reference 

= the random error in the range measure- 
ment . 

The estimated measurement is computed from 


mr 


= / (x-x^) + 


-N 2 2 

(y-y„) + <z-x„) 


(4.30) 


where 

/N. >\ /V 

x,y are state variables of the filter and z is 
obtained from the complementary filter. 

The nonzero elements of the row vector, H, for the 
range measurement are calculated from 

/^mr (4.31) 

The variance of the random error in the range 
measurement is assumed to be a constant given by 

Qjnr = (18.3m) ^ (4.32) 

The MODILS azimuth measurement is assumed to obey 


-1 f~ ^ ^ 


Y^a = tan [ (y-y^)//(x-x_^) + (z-z^) ] + q^a <4.33) 


where 


q = the random error in the azimuth measurement 
ma 


The estimated measurement is computed from 

yx ^ 2 T 

Y = tan C (y-y )//(x-x ) + (z-z ) I 
ma ^ ' ' m ' m 


(4.34) 
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The nonzero elements- of the row vector, H, .of (4.8) 
for the azimuth measurement are given by 

«n.a<2) = (4.35) 

where 

^ 2 2 T 

r = /(x-x^) + (y-y^) + (z-z^) 

2 Y 

r, = / (x-x ) + (z-z ) 

X iti m 

The variance of the random error in measurement 
is assumed to be a constant given by 

z 

Quja " (4.36) 

True Airspeed Model 

As was mentioned in Section III, the existing 
software calculates the level components of true airspeed 
in the runway reference from air data and attitude data. 

These calculated components are assumed to be measurements 
in the onboard filter rather than using a more complex 
mechanization involving actual raw data sensors. 

The along runway measurement of true airspeed is 
assumed to obey 

Y=v — w+a 

ax XX ^ax (4.37) 

where 

^x ~ gtound velocity along the runway 
= wind velocity along the runway 

the random error in the measurement 
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The estimated measurement is computed from 


where 


y = V 
ax X 


/V 


- w 


(4.38) 


V and w are state variables of the filter 

X X 


The nonzero elements of the row vector, H, of (4.8) 


are given by 

H(3) = 1 (4.39) 

H(9) = -1 


The 

is assumed to 


Q 


ax 


variance of the random error in the measurement 
be a constant given by 

= (.61m/s) (4.40) 


The 

is assumed to 
Y 

ay 


normal to runway measurement of true airspeed 
obey 

= V - w + q (4.41) 

y y ^ay 


where 


from 


where 



^ay 

The 


= ground velocity normal to runway 
= wind velocity normal to runway 
= random error in the measurement 

estimated value of the measurement is computed 



(4.42) 


V and w are state variables of the filter 

y y 
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The nonzero elements of the row vector, 
are given by 


H 

H 


ay 

ay 


(4) 

( 10 ) 


1 

-1 


H, of (4.8) 


(4.42) 


The variance of the random error in the measurement 
is assumed to be a constant given by 

Q = (.61m/s) (4.43) 

4 . 4 Measurement Preprocessing 

The onboard filter contains routines for calcula- 
ting the residuals and partials (H vector) and summing the 
results appropriately at a 10H§ frequency. Each residual 
sum and its partial are transferred to appropriate arrays 
for processing by the Kalman filter algorithm at a iHz 
frequency. 


The preprocessing routines contain the logic for 
executing the following steps in a sequential manner for 
each measurement: 

1. Test of hardware validity flags. If measure- 
ment is invalid, the subsequent steps are 
bypassed. This step is omitted for the air- 
speed measurement since there are no hardware 
validity flags. 

2. Calculation of the residual (measurement minus 
computed measurement) . 

3. Test of the reasonableness of the residual. 

If the residual magnitude exceeds a precomputed 
tolerance level the subsequent steps are 
bypassed . 
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4. Accumulation of the residual into the residual 
sum. 

5. Calculation of the H vector for the measurement 

and referencing the vector to time t^, by 

H = H(t) ^1. 
m 

6. Accumulation of elements of H into the partial 

m 

sum. 

7. Incrementing a measurement counter by unity. 
(The number of valid measurements in each sum 
is calculated) . 

The TACAN bearing and MODILS azimuth measurements 
have additional logic before step (2) which rejects the 
measurement if the ground distance from the station (or 
scanner) to the aircraft is less than 305 meters. 

Following completion of the above logic for all the 
measurements, a marker is tested to determine if an incre- 
mental state change is ready for input to the state. These 
changes are calculated by the iHz filter logic as was 
described in Section (4.1). If the change is ready then all 
the residual suras are modified in accordance with linear 
theory to account for this change (see Equation 4.9). Every 
second the residual sum and partials are transferred to 
arrays used in the iHz filter logic for calculating the 
incremental state. 

The variance of the random error in each residual 
sum is calculated from 

= qL "x (4.44) 
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where 


= the variance for an individual measurement 

XX 

(see Section 4.3) 

i 

n = the number of residuals in the sum. 

X 


4 . 5 Measurement Rejection 


In addition to the validity flags and residual 
reasonableness tests mentioned in the previous section, a 
test is made on the reasonableness of the residual sum before 
it is used to calculate an incremental state change. The 
Potter algorithm (see Equation (4.14)) requires calculation 
of the quantity 

io^) = + Q (4.45) 

Let 

Ay = the residual svan for the particular a 
"^m ^ m 

involved. 


if 


Then the onboard filter rejects the measurement 


c I Ay I > a 


m. 


(4.46) 


The best value of the coefficient, c, has not been 
determined. A value in the range of .25 ^ .5 is believed to 
be reasonable. 


The value of a for each measurement is stored and 
m 

used in the reasonableness test prior to summing the residual 
(Step 3 of Section 4.4). 


4.6 Filter Initialization 

The onboard mechanization is arranged such that the 
start of initialization or reinitialization occurs consistent 



with that of the existing complementary filter. This was 
set up to give valid comparison of the performance of the 
two filters during the simulation and flight test phases. 

The initialization of the Kalman filter consists 
of the following: 


1. Setting the position (x,y) state variables 
from TACAN and barometric altimeter data, 

2. setting the velocity (v^/ v^) state variables 
at the runway referenced true airspeed values, 

3. setting wind, acceleration bias and TACAN 
measurement bias state variables zero, and 

4 . setting the initial square root matrix in a 
manner consistent with the above. 

The position components are calculated from 


X = X. - r cos (All;) 
t c 

y = y^ - r^sin(Ai|;) (4.47) 

where 

^ Yf r ^ 

hj^ = altitude above TACAN station computed from 
barometric altitude 

= Ytb - 


The velocity components are given by 

V = Y 

X ax 

V = Y 


y ay 


(4.48) 
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The nonzero 

elements of the initial square root 

matrix 

are given by the 

following: 

(1,1) 

= cos(Ai[»)aj,j^ 

= std of range bias - 305m 

(1,2) 

= sin(Ai|^)aj^j^ 


(1,7) 

~ ^rb 


(2,1) 

= cos (Alp) a. , 
rr 

^rr = std of random error in the range 
measurement - 37m 

(2,2) 

- sin (Ai|/)a 

^ rr 

• 

(3,1) 

= ‘^T ■ V 

^i|ib = std of bearing bias - 2 deg 

(3,2) 

= <*T • V 


(3,8) 

~ ®l(;b 


(4,1) 

II 

= std of random error in bearing 

(4,2) 



(5,3) 

= -cos'{il^ )<y ^ 

a r vt 

= std of random error in airspeed 
measurement .61 m/sec 

(5,4) 

= -sin (i|^ )a ^ 

a r vt 


(6,3) 

= V a, 

y 

= std of error in heading S 2 deg 

(6,4) 

= -v a, 

X ijia 


(7,3) 

=s a 

xw 

0 = std of X component of wind % 

^ 6.1m/sec 
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(7,9) 


- a 

xw 


(8,4) 



(8,10) = cr 

yw 


= std of y component of wind 
^ 6.1 m/sec. 


where 

= the magnetic heading measurement at time of ini- 
tialization. 


4 . 7 Memory and Real-Time Requirements 

The complementary filter used in the STOLAND sys- 
tem (see Reference [2]) requires approximately 400 words of 
instructions and constants and approximately two percent (2%) 
of the available real-time of the 1819A computer. The Kalman 
filter described in this report requires approximately 2,200 
words of instructions and constants and about 22.7% real-time 
of the 1819A computer. The real-time is distributed between 
the different functions as tabulated below. 

Functi on Real-time (%) 

Raw data transfers and naviga- 
tion equation logic (Figures 

A. 2 and A. 3 of Appendix) .40 

Measurement preprocessing logic 

(Figure A. 4 of Appendix) 4.74 

Kalman filter iHz logic 

(Figure A. 5 of Appendix) 17.56 

22.7 

As may be seen, the iHz logic requires the largest 
percentage real-time. If we were to execute this logic at 
,5Hz, then the real-time requirements would change to those 
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tabulated below. 


Function Real-time (%) 

Raw data transfers and navi- 
gation logic .37 


Measurement preprocessing 
Kalman filter .5Hz logic 


4.56 

8.78 

13.71 


The real-time required for the first two functions reduce 
slightly since the incremental state changes and residual sum 
transfers occur half as frequently. The real-time required 
by the third function is reduced by a factor of 2. As is 
seen, the real-time requirements of the Kalman filter could 
be reduced by about 40% by using a two-second filter cycle. 
Some performance degradation of the Kalman filter would be 
encountered by increasing the cycle time to two seconds. 
Information relating the performance and filter cycle time 
could be a useful result of future effort. 
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V. 


SIMULATION RESULTS 


NASA facilities for the STOLAND include the STOLAND 
simulator which was developed to provide validation of flight 
software and hardware (see Reference [2]). This facility was 
used to checkout the Sperry 18 19 A computer program as modified 
to include the Kalman filter logic. Following checkout. of the 
program a few sample flights were run in order to compare the 
Kalman filter outputs with the complementary filter. Since 
this was a simulation, the true positions and velocities were 
available so that the actual error time histories for both 
filters could be formed. The desired quantities were all cal- 
culated and buffered for output to a line printer. Unfortun- 
ately, the output frequency was less than . 5Hz so the high fre- 
quency characteristics of either filter was not recorded. Time 
did not permit software changes to provide magnetic tape records 
or strip chart records to give the high frequency characteristics , 
so the evaluation was restricted to the low frequency charac- 
teristics. 

The approach trajectory and MODILS and TACAN sta- 
tion locations used in the simulation evaluation are shown on 
Figure 5.1. The STOLAND simulator and existing 1819A software 
are such that one may prescribe a reference path for automatic 
guidance of the simulated aircraft (see reference [2]) . For 
this example the problem was initiated in a manner that gave 
an early capture (within 20 seconds) onto automatic guidance 
which was retained for the remainder of the trajectory. The 
onboard guidance uses the complementary filter for navigation 
purposes. 

During the first 122 seconds of the trajectory shown 
on Figure 5.1, both filters use the TACAN measurements. At 
this time they both switch to the MODILS measurements which 
are used for the remainder of the flight. The error models 
used for the simulated navaid measurements are described in 
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y position, km 



Figure 5.1. Approach Trajectory Used for Filter Evaluation 


reference (2) . For the specific examples presented here, the 
TACAN range bias was -305 meters and the TACAN bearing bias 
was -2°. These biases are the primary contributors to the 
relatively large errors between the complementary filter out- 
puts and actual trajectory shown on Figure 5.1. The Kalman 
filter, which includes the bias errors as state variables, 
has considerably smaller errors. 

The velocity time histories for the approach trajec- 
tory of Figure 5.1 are shown in Figure 5.2. The complementary 
filter velocity estimate is seen to deviate considerably from 
the actual trajectory values. Figures 5.3 and 5.4 give time 
histories of the position and velocity errors for both filters. 
The data here was plotted at 10-second intervals and straight 
lines drawn between points. The error time histories generally 
illustrate the superior performance of the Kalman filter during 
TACAN data and for the transition phase in switching between 
navigation aids. After about 200 seconds the errors for either 
filter are very small. 

Figure 5.5 presents the time histories of the 
parameter estimates obtained from the Kalman filter. The 
Kalman filter obtains a reasonably good estimate of the TACAN 
range bias while using the TACAN data. This is largely a 
result of the trajectory used which passes by the TACAN station 
as seen on Figure 5,1. The TACAN bearing bias is partially 
estimated during the TACAN data phase. The wind estimates 
shown on Figure 5,5 are actually errors since the winds used 
in the simulation are zero for this case. The wind errors 
during the TACAN data phase are primarily due to the ground 
velocity errors. After switching to MODILS, the errors are 
smaller and are believed to be caused by software approximations 
in transforming the airspeed to the runway reference. The 
acceleration bias time histories shown on Figure 5.5 are also 
errors since there were no intentional sources of bias in the 
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Figure 5,4. Velocity Errors on the Approach Trajectory 


- 42 - 





range bias, meters 


Time , sec 





simulation. The estimates obtained from the filter are small 
and considered acceptable for this example. These states 
were introduced to compensate for errors in the attitude and 
heading reference used in transforming the body-mounted accel- 
erometer data to runway reference. How well they compensate 
for such errors, particularly during maneuvering, needs fur- 
ther investigation. 

Figure 5,6 presents the average residuals for the 
approach trajectory. An examination of the data indicates a 
standard deviation of about 61 meters for the TACAN range 
noise and about .08° for the bearing noise. The individual 
range .measurement noise (if random errors are independent) 
would be about 193 meters rather than the 46 meters indicated 
in equation (4.24). The TACAN range variance used in obtaining 
the data shown in Figures 5.1 to 5.5 was obtained with Q = 

o 2 . 

(183m) rather than (46m) . The TACAN range variance of = 
(46m) ^ was obtained from analysis of flight data. The TACAN 
bearing noise is believed to be too small in comparison to 
flight experience. These factors indicate the models given 
in reference [2] should be improved to give a more consistent 
agreement with the actual flight experience. 

Figure 5.7 compares the velocity errors for the two 
filters on a different run where the Kalman filter measurement 
variances are as given in section 4.3. The high frequency com- 
ponents of the velocity errors for the Kalman filter are 
worse than those of the complementary filter. This data led 
to increasing the TACAN range variance for the run presented 
in the previous figures. 

Figure 5,8 compares the velocity errors in the 
presence of a 10-knot crosswind and wind gusts. The velocity 
errors for the Kalman filter after about 220 seconds were 
slightly higher than those of the complementary filter. This 
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Figure 5,6. Residuals on the Approach Trajectory 
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y velocity error 




y velocity error, m/s x velocity error, m/s 




is believed to be caused by either too high a weight on the 
true airspeed data or an insufficient coinpensation for wind 
changes in the wind model. These factors also need further 
investigation. 
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VI. 


CONCLUDING REMARKS AND RECOMMENDATIONS 


At the initiation of the filter development described 
herein, it was generally known that a Kalman filter could be 
developed to give improved performance over the complementary 
filter. The performance improvements are gained, however, at 
the expense of computer memory and real-time. Whether the 
Kalman filter could be made simple enough to fit within the 
available memory and real-time in the STOLAND system computer 
and still give improved performance over the complementary 
filter was not known. One of the encouraging results is that 
the Sperry 1819A computer in STOLAND is sufficiently large and 
fast to allow a meaningful test evaluation of advanced navi- 
gation systems while still performing all the other necessary 
guidance, display and control calculations of the STOLAND 
design. 


The memory and real-time constraints were satisfied 
by (1) keeping the number of state variables to a bare minimum, 
and (2) using data averaging techniques to reduce the number 
of measurements requiring filter calculations. This design, 
therefore, uses the accelerometer data for keeping the posi- 
tion and velocity estimates current at the high rate needed 
for guidance, control and display purposes. Previous designs 
had used this same philosophy; however, the acceleration data 
was from high quality inertial components. The inertial ref- 
erence in STOLAND is a strapped-down type employing relatively 
inexpensive components whose errors are probably two orders of 
magnitude greater than inertial quality components. These 
errors were adequately compensated by the simple filter design 
with no apparent problems with the one-second delay of the 
filter calculations. Very likely the strapped-down reference 
is good enough to use a larger delay and reduce the filter 
real-time requirements further with- only minor performance 
degradation. 
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Information relating performance degradation and 
real-'time reductions could be a valuable output from further 
work. 


Some additional areas where further work is recom- 
mended are as follows: 

1. The existing filter has no means of providing 
direct (instantaneous) compensation for head- 
ing errors in the inertial reference. The 
addition of this variable to the state vector 
could give improved performance during 
maneuvering where heading errors can be 
moderately large. 

2. The airspeed data software should be 
thoroughly reviewed. It is believed that 
the wind and velocity estimates could be 
improved with relatively minor software 
improvements. 

3. The problem of interfacing the Kalman filter 
with real-time guidance, display and control 
needs investigation. The current filter 
should be connected to these functions and 
any problems with the discrete changes in 
state of the filter resolved by simulation 
tests . 

4. Potential performance improvements and com- 
plexity in adding a vertical channel (z axis) 
should be studied. 

5 . A three-axes navigation system employing 
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a Kalman filter should be designed and 
interfaced with the STOLAND guidance, con- 
trol and displays. Flight and simulation 
tests of such a design would be a good 
final validation of the advantages/disad- 
vantages associated with a moderately 
sophisticated navigation system in STOL 
aircraft. 
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APPENDIX 


Description of the Onboard Program 

The Kalman filter described in the body of this re- 
port was designed to operate as an experiment within the left- 
over memory and real-time of the STOLAND Twin Otter software. 
The experimental objectives were to calculate and record the 
Kalman filter outputs using the same raw data sources as those 
of the complementary filter. The complementary filter outputs 
are also recorded at the same time as those of the Kalman fil- 
ter; therefore, post-flight evaluation of the flight data will 
permit direct comparisons of both filter outputs with ground 
tracking data. 

This Appendix describes the Kalman filter logic of 
’ the overall program and the executive which provides the time 
sharing between the existing software and the Kalman filter. 

A comparison of memory and real-time requirements of the two 
filters and some details on how the real-time is distributed 
between different parts of the Kalman filter is also presented. 

A. 1 Executive Driver 

In order to provide the available real-time to the 
Kalman filter logic, it was necessary to develop a new execu- 
tive for the Twin Otter program. A macro flow chart of this 
executive is presented in Figure A.l. At program start ini- 
tialization logic is executed. The interrupts are then enabled 
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Figxire A.l. Macro Flow Chart of Executive for STOLAND Software 
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and the far background logic is entered. The program waits 
in the far background routine until an interrupt occurs. 

The STOLAND system contains several sources of program inter- 
rupt; however, we will only describe the main stream of calcu- 
lations which are triggered by the IkHz internal clock of the 
1819A computer. A clock interrupt causes transfer to a loca- 
tion where a counter is decremented and tested to determine 
if it is time to initiate the 20Hz calculations. If not, the 
program returns to the location where interrupted and con- 
tinues execution. 

If it is time to start the 20Hz logic, then the neces 
sary quantities for recovery from the interrupt (registers, 
location at intercept, etc.) are saved in a software push- 
down stack. The program then executes the Twin Otter navi- 
gation, guidance, control and display software. Following 
completion, the program executes the software for interfacing 
the Kalman filter with the overall program. The next logic is 
a test to determine if it is time (every other cycle) to 
start the lOHz calculations of the Kalman filter. If not, the 
executive restores all the quantities saved in the push-down 
stack and branches to the saved interrupt location. In this 
instance, the program branches to the lower priority logic in 
the order (1) lOHz (if not complete) ; (2) IHz (if not complete) 

or (3) far background. 

If the lOHz logic is to be initiated a marker is 
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tested to see if the previous cycle calculations were com- 
pleted before the interrupt. If not, a STOP is executed 
since either a software or hardware problem has prevented 
completion of the lOHz logic within the allowed time. With 
no malfunction the program then executes the lOHz Kalman 
filter logic. Following completion of the lOHz logic, a 
test is made to determine if the iHz Kalman filter logic should 
be initiated. If not, the executive restores all the quanti- 
ties saved in the push-down stack and branches to the saved 
interrupt location. In this instance, the program branches 
to the lowest priority logic in the order (1) IHz (if not 
complete) ; (2) far background. If the iHz logic should be 

initiated, a marker is tested to see whether the previous 
cycle calculations were completed in the allowed time. If 
not, a STOP is executed. If no malfunction, the iHz logic is 
initiated. 


Following completion of the IHz logic, the execu- 
tive restores the quantities from the push-down stack and 
branches to the saved location. In this instance the saved 
location is in the far background logic. 

A. 2 2 0Hz Kalman Filter Logic 

The Kalman filter logic which is executed at 20Hz 
is shown in Figure A. 2. The first test is to determine if 
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data should be generated internally for a straight-line path. 
This logic was used for check-out phases and is a convenient 
way of checking the Kalman filter operations for new assem- 
blies. It can be removed at any time. For normal operation 
the routine transfers the raw acceleration data from the com- 
plementary filter locations to the Kalman filter storage at a 
20Hz rate. A test is then made to determine if the particular 
entry is at the starting time for a lOHz cycle. If true, then 
the navigation aid measurements and their validity flags are 
transferred from locations used by the complementary filter to 
locations used by the Kalman filter. The raw acceleration 
data are then accumulated (at 20Hz) with those of the pre- 
vious cycle and a test made to determine if the entry corre- 
sponds to that for starting the lOHz logic of the filter. If 
true, the accumulated sum is transferred into locations for 
use by the navigation equations and the sum locations reset 
to zero . 


A. 3 Navigation Equation Logic 

Figure A, 3 shows the navigation equation logic 
which is executed at lOHz . The first operation is a test 
for determining if initialization is required. This marker 
is set true when the complementary filter begins its ini- 
tialization. 
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Figure A. 3. Macro Flow Chart of Navigation Equation Logic. 


If initialization is required, then the validity 
flags for the TACAN data are tested. If both the range and 
bearing are valid, the state variables are initialized and the 
initialization marker set false. If TACAN is not valid, the 
routine returns. 

If initialization is not required, the logic inte- 
grates for the position and velocity using the acceleration 
data. Following the integration, a marker is tested to deter- 
mine if a state change is ready. If it is ready, then the 
change is added to the estimated state and the routine returns . 
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A. 4 


Measurement Preprocessing Logic 


Figure A. 4 shows the measurement preprocessing logic 
which is executed at lOHz. A marker is tested first to see if 
the preprocessing logic has been initialized. This marker is 
set true after the state variables have been initialized for 
the navigation equations (Figure A. 3), After initialization 
(if it is required) , the logic does the necessary preprocessing 
for the TACAN, MODILS, and airspeed data as described in sec- 
tion IV-. The transition matrix elements are then updated so 
the matrix is valid for the next entry. The incremental state 
change marker is then tested. If true, the residual sums are 
corrected, and the incremental state change is updated with the 
transition matrix. The change ready marker is then set true 
for use by the logic of Figure A, 3, Following this, the 
residual sum cycle marker is tested. Every tenth entry, the 
marker is true and the logic shown is executed. 

A. 5 Kalman Filter IHz Logic 

Figure A, 5 shows the Kalman filter logic which is 
executed at iHz. The first test determines if initialization 
is required. If true, the quantities shown are initialized 
and the initialize marker set false before return. If the 
initialize marker is false, a test is made to determine if 
there are any measurements (residual sums) to be processed. 

If true. Potter! s algorithm (see section 4.1) is used to 
process each available residual sum in a sequential manner . 
After completion, the incremental state change marker is set 
true for use in the logic of Figure A. 4. Following this, 
the square root matrix is updated to the beginning of the next 
measurement accumulation period (see section 4.1). 

A. 6 Summary of Kalman Filter Routines 

Table A.l presents the name and function of the 
Kalman filter routines developed for the Sperry 1819A computer. 
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Figure A. 5. Macro Flow Chart of the Kalman Filter iHz Logic. 
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Twenty-one (21) routines are involved in .the Kalman filter 
logic. The 1819A assemblies of these routines contain a num- 
ber of descriptive comments for clarifying the function of 
the 1819A instructions. 

TABLE A.l. Kalman Filter Routines 


Name 

AIRRES 

CRESID 

DATTRF 

FILNIT 

HTPJHI 

KALM 

LOADR 

MODRES 

MCWT 

MESCAL 


Function 

Computes airspeed residuals and partials and accu- 
mulates results into preprocessing storage locations. 

Corrects all residual sums for the incremental state 
change . 

Transfers raw data from locations of the complemen- 
tary filter to locations used by the Kalman filter 
(see Figure A. 2). 

Initializes the square root covariance matrix, the 
transition matrix and the matrix of sensitivity to 
forcing functions. 

References measurement partials to the filter ref- 
erence time and accumulates result with the previous 
sum. 

This is the driver for the iHz logic of Figure A. 5. 

Transfers residual sums and their partials to arrays 
used by the iHz Kalman filter logic. Clears accumu- 
lation locations used by the measurement preproces- 
sing logic. 

Performs all preprocessing calculations for MODILS 
range and azimuth measurements. 

Executes Potter *s algorithm for calculating the in- 
cremental state and the square root covariance for 
each measurement (residual sum) . 

This is the driver for the measurement preprocessing 
logic of Figure A. 4,. 
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NAVEQ 


PHIX 

REDWT 

RND, RNDA 
SETUP 

SIMMES 

SUMACC 

TACRES 

TIMUPD 

UPDATX 

UPTWT 


This routine executes the navigation equation logic 
of Figure A. 3. 

Updates the incremental state change over one filter 
cycle (1 second) • 

Reduces square root covariance to upper triangular 
form using Householder's Algorithm- 

Rounds A register into single precision in AU. 

Initialization for filter markers, printer and 
straight-line flight simulation. 

Computes simulated measurements for a straight-line 
flight. 

Acciamulates acceleration data at 20Hz and transfers 
values to filter at lOHz, 

Performs all preprocessing calculations for TACAN 
range and bearing measurements. 

Updates transition matrix elements at lOHz. 

Updates the incremental state change for a fraction 
of the filter cycle. 

Forms the updated square root covariance in expanded 
form. 
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A. 7 
20Hz 

lOHz 


IHZ 


Summary of Equations 

The equations solved in the 1819A computer are summarized below. 


Accumulate 

measured 

accelerations 




1 1 

a = a 

s s 

+ X 

r 

X axis acceleration 

sum 



2 2 

a = a 

s s 


y axis acceleration 

sura 



(A = .1 sec.) Update state equations 




x^(t+A) = 

X^(t) + 

r i— 2 i+2 , . . , 

[a /2 + X (t) ] A 

s 

update velocities 

i=3,4 

x^(t+A) = 

x^(t) + 

[x"-'^^(t+A) + x'*-'^^(t)]A/2 

update 

positions 

i=l , 2 

x^(t+A) = 

x^(t) 


update 

states 

i=5,10 


Measurement preprocessing; Executed for all valid measurements (k=l,6) 


A ^ 

Ay 

= - 


compute residual 


k 

= + 
S 

Ay'' 

residual Siam 



11 

< 


compute gradient 

(partial) 

m 

s 

k, 

= H 

m 

s + 

h’' 

m 

refer partial to 
iHz cycle 

partial sum 

beginning of 


(A= 1 sec.) Update incremental state and covariance matrix using 
Potter’s algorithm: Executed for each of the four 
measurements in effect (MODILS + airdata or TACAN + 
airdata) 


Ic k 

H WW (H ) 
s s 


variance in residual 


dx 


W 


dx + - H^dx]/S 

s s s k 

- w'^(h^)'^hNwV[s, (1 + ) ] 

S S X K 


update incremental state 
vector 

update square root co- 
variance matrix 


Add incremental state to state estimate (i=l, 10) 


dx(t) 

i 

X 


$dx 

+ dx^ 


refer state change to current time 
update states 


dx 


= 0 


Update W with forcing functions 


W (t+A) = 


w"^(t)0 


^ J 

T 

W (t+A) -► upper triangular form using Householder's algorithm. 
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